#include "WPILib.h"
#include "Robot2489.h"

Robot2489::Robot2489(void) {
	screen = DriverStationLCD::GetInstance();
	ds = DriverStation::GetInstance();
	dseio = &ds->GetEnhancedIO();
	//InitLimitSwitch();
	lowOutSwitch = new DigitalInput(1);
	lowInSwitch = new DigitalInput(2);
	feederSwitch = new DigitalInput(3);
	midOutSwitch = new DigitalInput(4);
	midInSwitch = new DigitalInput(5);
		
	myRobot = new RobotDrive(leftMotor, rightMotor); // these must be initialized in the same order
	
	
	leftStick = new Joystick(1);
	rightStick = new Joystick(2);
	manipStick = new Joystick(3);
	
	manipulatorJag = new Jaguar(6);
	leftMotor = new Jaguar(9);
	rightMotor = new Jaguar(10);
	
	myRobot->SetExpiration(0.1);	
}
/*
void Robot2489::InitLimitSwitch()
{
	lowOutSwitch = new DigitalInput(1);
	lowInSwitch = new DigitalInput(2);
	feederSwitch = new DigitalInput(3);
	midOutSwitch = new DigitalInput(4);
	midInSwitch = new DigitalInput(5);
}*/
